static void pit_timer_fn(void *data)
{
struct vmx_virpit_t *vpit = data;
+ s_time_t next;
+ int missed_ticks;
+
+ missed_ticks = (NOW() - vpit->scheduled) / MILLISECS(vpit->period);
/* Set the pending intr bit, and send evtchn notification to myself. */
if (test_and_set_bit(vpit->vector, vpit->intr_bitmap))
vpit->pending_intr_nr++; /* already set, then count the pending intr */
- set_ac_timer(&vpit->pit_timer, NOW() + MILLISECS(vpit->period));
+ /* pick up missed timer tick */
+ if ( missed_ticks > 0 ) {
+ vpit->pending_intr_nr+= missed_ticks;
+ vpit->scheduled += missed_ticks * MILLISECS(vpit->period);
+ }
+ next = vpit->scheduled + MILLISECS(vpit->period);
+ set_ac_timer(&vpit->pit_timer, next);
+ vpit->scheduled = next;
}
vpit->intr_bitmap = intr;
- set_ac_timer(&vpit->pit_timer, NOW() + MILLISECS(vpit->period));
+ vpit->scheduled = NOW() + MILLISECS(vpit->period);
+ set_ac_timer(&vpit->pit_timer, vpit->scheduled);
/*restore the state*/
p->state = STATE_IORESP_READY;
/* for simulation of counter 0 in mode 2*/
int vector; /* the pit irq vector */
unsigned int period; /* the frequency. e.g. 10ms*/
+ s_time_t scheduled; /* scheduled timer interrupt */
unsigned int channel; /* the pit channel, counter 0~2 */
u64 *intr_bitmap;
unsigned int pending_intr_nr; /* the couner for pending timer interrupts */